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PREdicting  Mobility  using  STATistics  ( PreMoStat) 


Meaningful 


PDFs 


Physics-Based  Simulation  Models 

Detailed  running  gear,  drive-train, 
obstacle  models  (ADAMS) 


Statistical  Characterization 

Interaction  with  hard  surface 
friction  and  soil  models 


Experimental  Testing 

Validation  data  from 
SwRI  Ground  Robotics  Testbed 


PackBot  Modal 
with  and  without  flippers 


Statistical  Obstacle  Models 

Variable  physical  and 
surface  properties 


Phase j 

•  Develop  Monte  Carlo  model  of  PackBot  climbing  step,  varying 
step  height  and  surface  friction 

•  Validated  predicted  traverse  with  empirical  test  data 

Phase // 

•  Extend  methods  to  deformable  terrain  (e.g.,  sand) 


Purpose: 

•  To  develop  methods  and  software  to  determine 
whether  a  given  Small  Unmanned  Ground  Vehicle 
(SUGV)  can  traverse  a  given  terrain,  when  both 
the  SUGV  and  the  terrain  are  not  known  exactly: 

•  Develop  efficient  UGV  simulations  that 
incorporate  statistical  variability  in  vehicle- 
terrain  interactions 

•  Establish  experimental  methods  to  validate 
statistical  models  for  vehicle-terrain 
interactions  for  typical  obstacles/terrains 

•  Evaluate  simulation  efficacy  using  an  Army¬ 
relevant  SUGV  on  testbed  terrains  and 
obstacles 

Results: 

•  A  novel,  efficient  statistical  simulation  framework 
for  predicting  off- road  robot  mobility 

•  Quantification  of  prediction  accuracy  on  realistic 
terrains  and  obstacles 

•  Validated  models  for  vehicle- terrain  interactions 

Paygffi 

•  I  ncreased  survivability,  reliability,  and  mission 
effectiveness  in  all  terrain  conditions 

•  I  nsight  into  observed  robot  performance  in  tests 
and  in  the  field 

•  Model  for  integration  into  UGV  simulation 
environments 


Phase  1  Summary 


Collected  real-world  data  on  non-deformable  steps 
Built  and  validated  a  baseline  mobility  model 
Found  two  key  parameters:  friction  and  step  height 


Confirmed  that  the  model  predicts  the  ability  of  a 
PackBot  to  climb  a  non-deformable  step  obstacles 
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Validation  Data 


Built  a  validation  fixture  at  SwRI 

-  Platform  motion  using  Vicon  motion  capture  system 

-  PackBot  internal  data  measurements 

-  On-board  SwRI  power  logger 

-  Reference  video 

Collected  non-deformable  surface  test  data 

-  5  Non-deformable  surfaces,  multiple  heights,  standard  speed 

Collected  deformable  surface  validation  data  using  sand 

-  2  types  of  cement  curbs,  4"  and  1"  radius 

-  Range  of  curb  heights,  from  success  to  failure 

-  4  speeds 

-  2  sand  depths 

-  4  yaw  angles 


Fixture  Parameters 


A*,  h, 
nhfi  i  ■  j  f  r*^i *v|S 

v  % 
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radius/  shape 
~  V 

'l 

\  h 


-  Curb  height  h 

-  Curb  material  /J 

-  Curb  radius/shape  r 

-  Yaw  angle  relative  to  curb  01 

-  Surface  material  depth  d 

-  Velocity  of  the  robot  v 

-  Surface  material  properties  (non-deformable) 

-  Flipper  angle  02 


The  Fixture 
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Sand/ Soil  tray  is  fixed,  curb  and  landing  platform  move  vertically 


Motion 

Capture 

Camera 

Movable 

Curb 

PackBot 

Sand 

Smoothing 

Device 


Gantry  for 
Swapping 
Curbs 


Alternate 

Curb 

Landing 

Platform 


Sand/  Soil 
Bin 
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Fine  Height  Adjustment 


Cement  Curb 


Crank  &  ■ 
Mechanism 


Adjustment  mechanism  raises/lowers  curb  1mm  per  turn  of  the  crank 
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Sand  Depth  and  Leveling 


Leveling  device  is  adjusted  to  set  the  depth  of  sand 
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Non- Deformable  Surfaces 
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Testing  the  surfaces  used  in  Phase  1  with  4"  radius  concrete  curb 


Some  Failure  Modes  in  Sand 
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Video 
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(Please  click  to  play) 


Disposition  of  Data 


We  used  the  data  for  validating  the  simulation  model 

A  set  of  Matlab  functions  were  developed  to  process 
and  synchronize  the  data 

The  data  was  provided  to  performers  on  the  DARPA 
Maximizing  Mobility  and  Manipulation  (M3)  program 

All  of  this  data  is  available  for  further  distribution 

-  Would  need  to  look  into  any  iRobot  proprietary  issues  for 
release  outside  the  Government 


SwRI  continues  to  refine  their  data  collection  processes 
and  is  available  to  collect  further  data 
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Developing  a 
Simulation  Model 
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Overview 

1.  What  Was  Done 

2.  Why  Was  This  Done 

3.  Results 

4.  Comparison  of  Simulation  and  Test  Results 

5.  Animations  of  Simulation  Results 

6.  Development  of  Deformable  Terrain  Subroutine 

7.  Discussion  of  ADAMS  Solver  Simulation  Process 

8.  Discussion  on  Slip-Sinkage  Model 

9.  ADAMS  Model  Demo 

10.  Concluding  Remarks 


What  Was  Done 


-  Developed  a  subroutine  for  integrating  specific  track-terrain  interaction 
models  into  ADAMS  for  predicting  mobility  on  deformable  terrains. 

-  Utilized  ADAMS  command  language  to  efficiently  build  a 
parameterizable  system  model  (rigid- bodies,  forces,  constraints,  etc.) 

-  Developed  a  means  for  integrating  slip-sinkage  into  the  track- terrain 
interaction  model. 


These  new  methods  were  fully  implemented  in  ADAMS  and  evaluated 
using  data  collected  during  experiments  with  an  i Robot  PackBot  at 
SwRI . 


Why  Was  This  Done 
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Need  a  parameterizable  track-terrain  model  for  small 
scale  UGV  (PackBot)  that  could  be  used  for  statistical 
mobility  prediction  studies. 

Having  a  reliable  parameterizable  system  model  can  have 
saving  benefits  (money  and  time)  as  opposed  to  physical 
testing. 

The  ability  to  model  highly  deformable  terrain  interaction 
does  not  exist  in  ADAMS,  so  a  customized  subroutine  was 
required. 

The  ability  to  evaluate  small  UGVs  operating  in  extreme 
maneuvers  requires  we  be  able  to  account  for  slip- 
si  nkage. 
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ADAMS  Vehicle  Model 


-  Chassis,  Sprocket  and  Idler  geometries  imported  from  CAD 
system  ( Sol idWorks) . 

-  Track  segment  geometry  was  created  in  ADAMS  environment 
allowing  for  parameterization. 

-  Solid  model  geometries  can  easily  be  changed  by  simply 
importing  the  modified  geometry  file. 


I  m proved  Dynamics  Model 


-  Phase  1  PackBot  psuedo-track  model  was  a  set  of  cascaded  wheels 

-  Cleats  engaging/disengaging  with  terrain  introduced  bouncing  that 
reduced  accuracy  and  increased  simulation  time 

-  Results  show  improved  simulation  performance  even  though  new 
model  has  more  bodies  and  constraints 


Pseudo-track 

-  Cleats  were  attached  to  a  set  of  cascaded  wheels 
(Note  curvature  of  track  near  cleat) 


Segmented  Track,  36  segments 

-  Parameterized  -  c/eat  height,  taper  angle,  etc. 

-  Spring/damper  system  used  to  constrain  motion  of  track 
segments  relative  to  one  another 
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-  Non- Deformable  Terrain 

ADAMS  3-D  contact  model  was  implemented  to 
compute  both  the  normal  and  friction  forces  acting 
at  the  track  segment-curb  interface. 

The  normal  force  is  computed  using: 


Fnormal=ksAx”+bsf( A*)M  (Eq.  6) 


which  is  essentially  a  non-linear  spring/damper 
system. 


The  friction  force  is  modeled  as 


^friction  ^  \^slip) 


normal 


(Eq.  7) 


where  the  relationship  between  the  coefficient  of 
friction  and  slip  velocity  is  shown  on  the  figure  to 
the  right. 

Ax  =  Penetration  depth 
Ax  =  Penetration  rate 
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Model 
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Track  Model  PreMoStat 

-  Discretized  track  belt  (36x  segments) 

-3-D  contacts  between  segments,  sprocket,  idler  and  support 

-  Bushing  elements  constrain  motion  between  joining  segments 

-  I  n- plane  constraint  between  segment  and  track  support 

-  Parameterizable  cleat  geometry 


ADAMS  Graphical  Topology  Map 


-  Deformable  Terrain  Model 

Various  deformable  terrain  models  have  been  \ 

presented  in  the  literature  for  predicting  both  the 
normal  and  shear  loads  acting  at  the  track- terrain 
interface. 


Two  of  the  more  popular  methods  were  used  for  this 
study  because  of  their  ease  of  implementation  and  the 
fact  that  test  methods  exist  to  extract  values  of  their 
empirical  parameters.  However,  it  is  noted  that 
PreMoStat  model  is  not  limited  to  these  methods. 

To  start,  a  set  of  3x  orthogonal  force  elements  are 
applied  to  each  segment's  center- of- mass  (cm),  which 
move  with  the  body  frame.  For  ease  of  explanation, 
we  will  assume  an  instance  in  time  when  the  x,  y,  z 
force  components  are  along  the  longitudinal,  lateral 
and  vertical  directions,  respectively. 

The  next  sections  discuss  how  both  the  normal  and 
shear  loads  are  computed  and  distributed  among  Fx, 
Fy,  and  Fz. 


fi*,,  h 

<  f  j  un  $  i 
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3x  orthogonal  force  element 
acting  a  segment's  cm. 


—  Shear  Displacement  Model 

To  generate  traction  force,  shear  displacement  of  the  terrain  must  occur. 


The  total  shear  displacement  for  a  single  track  segment  is  defined  by: 


/  -2  .  -2 
J  -yjJx  +Jy 

where  the  components  of  the  shear  displacement  are  computed  by  integrating  the  slip 
velocity  in  the  corresponding  direction  starting  from  initial  contact  with  the  terrain: 

*c 

j)  =  J  v  dt  for  i  =  x,y 

o 


j  =  absolute  shear  displacement 
jx  =  shear  displacement  along  x-axis  of  SM 
j  =  shear  displacement  along  y-axis  of  SM 
vx  =  slip  velocity  expressed  along  x-axis  of  SM 
vy  =  slip  velocity  expressed  along  y-axis  of  SM 
tc  =  accumalitve  time  in  contact  with  the  terrain 
SM  =  marker  fixed  to  segment 
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Shear  Force  Model 
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The  shear  force  model  used  for  this  analysis  is  based  on  a  shear  stress-shear  displacement 
relationship  proposed  in  [3]  and  is  given  by: 


r  =  (c  +  cr tan K/j^J  (Eq.  8) 

The  total  shear  force  acting  on  a  given  track  segment  is  given  by: 

(Eq.  9) 


Track  segment 


F  —  t  A  +  t  A 

±  shear  L  base^base  L  cleat  ^cleat 


Therefore,  the  shear  force  components  are  given  by: 

F,  =  ~F shear  ^  & 

F,  =  ~F shear 


(Eq.  10) 


where, 


<9  =  atan2(v„/vv) 


c,  (j),  K  =  emperical  parameters 


a 


v 


v. 


A 


base 
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A 


cleat 


=  nomral  pressure 
=  slip  velocity  along  x-axis 
=  slip  velocity  along  y-axis 
=  base  normal  contact  area 
=  cleat  noraml  contact  area 


Normal  Force  Model 
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Therefore,  the  normal  force  acting  on  an  individual  track  segment  is  computed  as: 

^  ( K„  k  Zj}ase  A^age  ^  T  ^  kCss  k  Zcieat  A-c/ea/  ^  T  ^  l) 'damp  ^ base  }  (  Ey].  1 1) 

where  we  have  introduced  a  damping  term  to  minimize  oscillations  allowing  for  better 
numerical  stability  and  performance. 

Therefore,  the  vertical  force  component  is  given  by: 


Fz  =  ~Fn 


Fixed  marker 


Terrain  surface 


(Eq.  12) 


k  =  pressure  sinkage  parameter 
zhase  =  static  sinkage  of  base 
1  cleat  =  static  sinkage  of  cleat 


cleat 
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Aase  =  area  Of  base 

A,;„„=arcaofclcat 

zbase  =  sinkage  rate  of  base 

hdamp=  damping  parameter 
TM  -  marker  fixed  to  terrain 
SM  =  marker  fixed  to  segment 


Control  System 
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A  simple  PI  D  controller  was  implemented  to  control  the  kinematic  speed  of  the  vehicle, 
which  is  similar  to  how  the  physical  PackBot  control  system  operates. 


tSr  SL  =  right/left  sprocket  torques 
Rw  =  sprocket  hub  radius 
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Results 


-  A  user  subroutine  was  successfully  developed  for 
predicting  deformable  track- terrain  interaction  and  was 
implemented  into  an  ADAMS  UGV  system  model. 

-  A  para  meter  izable  UGV  vehicle  system  model  was 
successfully  developed  using  the  ADAMS  command 
language  allowing  for  a  more  automated  building  process. 

-  A  slip-sinkage  model  was  integrated  into  the  deformable 
terrain  model  and  shows  promising  results  considering  its 
simplicity  in  formulation. 

-  Because  of  the  extensive  detail  of  the  track  model, 
simulation  of  —9  (sec)  real  time  takes  ~2hrs  to  complete. 


Simulation  Test  Case 
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To  validate  the  ADAMS  PackBot  model,  simulation  results  were  compared  to  test  data 
collected  at  SwRI . 

The  test  cases  consists  of  the  PackBot  traversing  over  a  curb  obstacle  set  to  various 
heights  and  radii  with  the  base  of  the  curb  being  a  loose  sandy  terrain. 

The  speed  of  the  PackBot  was  set  to  operate  at  different  reference  speeds,  which  was  also 
accounted  for  in  the  simulation  using  a  PI  D  control  scheme. 

A  motion  capture  system  was  used  to  measure  the  position/orientation  and  velocities  of 
the  PackBot. 


Virtual  Test  Environment 


Physical  Test  Environment 


-  Simulation  Results 

The  following  test  case  was  simulated  and  compared: 
Curb  Height  =  163  (mm) 

Curb  Radius  =  4  (in.) 

Reference  Speed  =  300  (mm/ sec) 
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-  Test  Data 

-  Simulation  With  Slip-Sinkage 

Simulation  No  Slip  Sinkage 

j 

te 

p 

r 

1 

|  Total 

sinkage 

1500 


2000 


2500  3000 

Position  X-axis 


3500 


4000 


Max  Static  sinkage  ~  11.6  (mm)  —32  % 
Max  Slip-sinkage  —  24.2  (mm)  —68  % 
Max  Total  sinkage  —  35.8  (mm) 
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—  Animation  With  No  Slip-Sinkage 

This  animation  shows  a  simulation  result  of  the  ADAMS  PackBot  model  traversing  a  curb  of 
height  117  (mm)  and  radius  of  1  (in.)  at  300  (mm/ sec). 

This  version  of  the  deformable  terrain  subroutine  does  not  account  for  slip-sinkage,  but 
only  static  sinkage. 
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—  Ani mation  With  SI i p- Si nkage 

This  animation  shows  a  simulation  result  of  the  ADAMS  PackBot  model  traversing  a  curb  of 
height  117  (mm)  and  radius  of  1  (in.)  at  300  (mm/ sec). 

This  version  of  the  deformable  terrain  subroutine  accounts  for  si  ip-si  nkage  which  is  evident 
when  compared  to  the  previous  animation. 
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Developing  Terrain  Subroutine 
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ADAMS  allows  one  to  define  customized  force  elements  using  user-defined 
subroutines  coded  in  either  Fortran  or  C++. 

Because  of  the  complex  nature  of  deformable  terrain  interaction,  including  large 
terrain  deformations,  it  was  necessary  for  our  work  to  develop  a  user-defined 
force  subroutine. 

To  accomplish  this  task,  we  used  a  bottom  up  process  by  breaking  down  the 
subroutine  into  multiple  functions. 

•  Function  ->  computing  normal  forces 

•  Function  ->  compute  shear  forces 

•  Function  ->  terrain  query 

•  Function  ->  error  checking 


PreMoStat  GFOSUB.f 


Each  of  these  functions  were  developed  and  tested  on 
elementary  models  to  simplify  the  debugging  process. 


Check_Params.f 
Comp_Npressure_Bekker.f 
[=1  Comp_Shear_Stres£_Janosi.f 
Find_Terrain_Element.f 
ID  PreMo5tat_GF05UB.f 


2  KB  Fortran  Source 

2  KB  Fortran  Source 

1  KB  Fortran  Source 

3  KB  Fortran  Source 
14  KB  Fortran  Source 
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C  FILE  INFORMATION: 

C  Author:  Javier  M.  Solis 
C  File:  PreMoStat_GFOSUB 
C  Created:  04-18-10 
C  Mofified:  02-14-11 


C  DESCRIPTION: 

C  PreMoStat  subroutine  used  t 


i  model  deformable  terrains 


subroutine  GF0SUB(id,  time,  par,  npar,  dflag,  if lag,  result) 


implicit  none 

============  Type  and  dimens 


C  -  External  i 

integer 

double  precision 
double  precision 
integer 
logical 
logical 

double  precision 


statements  === 

iable  definitions  — 

id 

time 

par(  *  ) 

dflag 

result (6) 


id 

time 
par 
npar 
dflag 
if  lag 


Identifier  of  calling  GFORCE  statement 
Current  time 

Array  containing  passed  parameters 
Number  of  passed  parameters 
Differencing  flag 
Initial  pass  flag 

Array  (dimension  6)  of  computed  GFORCE 
components  returned  to  ADAMS 

-  Local  variable  and  parameter  definitions  — 

r ********************  Find_Terrain_Element.f  ************* 
Arguements : 

integer  msize(2) 

double  precision  dxy(2),  terrain_length,  terrain_width 
Output : 

integer  elem(2) 

i*****************  Comp_Npressure_Bekker . f  **************’ 


ADAMS  Solver  Simulation  Process 


ADAMS  Solver  (numerical  engine),  passes  the  kinematic  states  of  the  ith  track  segment  to 
the  PreMoStat.dll  subroutine.  I  n  turn,  the  subroutine  computes  the  normal  and  shear 
forces  and  passes  this  result  back  to  ADAMS  Solver.  This  process  is  repeated  for  each 
track  segment  at  a  given  iteration  time  step. 


Parameters 

? vzz 
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Xj ,  y- ,  Z-  =  position  of  track  segment 
VX- ,  vy  j ,  VZj  =  velocity  of  track  segment 

JXf ,  jyi  =  shear  displacement  of  track  segment 
Fx- ,  Fyi ,  FZj  =  forces  applied  to  track  segment 


Slip-Sinkage 


Shearing  of  the  terrain  leads  to  a  phenomenon  referred  to  as 
slip-sinkage. 

As  shearing  increases,  additional  sinkage  is  introduced  resulting 
in  bulldozing. 

The  total  sinkage  of  the  vehicle  is  the  sum  of  the  static  sinkage 
and  the  additional  sinkage  due  to  shearing: 


Z  total  Zo  Z  j 


(Eq.  1) 


The  figure  to  the  right  shows  how  the  total  sinkage  varies 
with  both  shear  displacement  and  normal  pressure.  The 
difficulty  of  implementing  slip-sinkage  is  separating  the 
contributions  of  the  two  components. 

Experience  has  shown  that  for  small  UGVs  (like  PackBot), 
the  component  of  total  sinkage  due  to  slip  is  dominant. 

Testing  has  also  shown  that  slip-sinkage  can  significantly 
effect  the  mobility  of  small  UGVs  under  extreme 
maneuvers  such  as  step  climbing  and  zero  radius  turns. 
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Total  Sinkage 


Slip-Sinkage  Model 


In  [1],  Lyasko  used  a  conservation  of  energy  approach  and  proposed  that  the  total 
sinkage  of  a  tracked  vehicle  can  be  captured  using: 


(Eq.  2) 


SS  O 


where 


(Eq.  3) 


The  significance  of  this  approach  is  that  the  total  sinkage  is  expressed  as  a  function  of 
slip  (or  shear  displacement)  and  static  sinkage,  both  of  which  can  be  computed  directly. 
Another  advantage  of  this  approach  is  that  no  additional  empirical  parameters  have  been 
introduced. 

zo  =  static  sinkage 

z  =  total  sinkage  (static  +  sinkage  due  to  slip) 
i  =  slip,  which  can  expressed  as  (j / x)  for  straight-line  motion 
j  =  shear  displacement 
x  =  position  of  track  segment  relative  to  track 


Slip-Sinkage  Model  (Cont.) 
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The  normal  pressure  acting  on  each  track  segment  is  based  on  a  pressure  sinkage 
relationship  proposed  in  [2]  and  is  given  by: 


P  = 


fk 


V 


—  +  ki  Zo=k-Zo 


(Eq.  4) 


b  j 

Accounting  for  slip-sinkage  and  inserting  (Eq.  2)  into  (Eq.  4)  and  rearranging  yields: 


p  =  K7-k-z 


(Eq.  5) 


Notice  as  slip  (or  shear  displacement)  increases,  the  value  of  Kss  decreases  reducing  the 
stiffness  k,  which  in  turn  yields  additional  sinkage. 


TM 


To  account  for  terrain  "memory”,  a  primitive  terrain 
query  model  was  implemented. 


The  value  of  K~n  for  each  element  of  the 
discretized  terrain  is  "tracked"  over  the 
simulation. 
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Conclusions 
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-  The  PreMoStat  UGV  (PackBot)  model  is  in  a  state  to  where  it  is  ready  to  be 
extensively  compared  with  test  results,  including  investigating  statistical 
variability. 

-  However,  to  improve  the  accuracy  of  the  UGV  (PackBot)  system  model,  the 
values  of  certain  parameters  need  to  be  measured/ estimated,  namely: 

-  Soil  parameters  related  the  shear  stress 

-  Parameters  related  to  damping  and  stiction  through  the  drivetrain 

-  Control  parameters 

-  Although  the  effects  of  slip-sinkage  have  been  accounted,  the  associated 
losses  (bulldozing)  should  be  integrated  to  more  accurately  predict  mobility 
performance,  especially  for  small  radius  turn  maneuvers. 
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The  Project 


We  developed  methods  for  using  UGV  sensor  data  to 
estimate  variables  and  parameters  needed  for  traction 
force  prediction. 


The  methods  were  evaluated  using  data  collected  from 
experiments  with  an  iRobot  PackBot  traversing  various 


deformable  and  non-deformable  surfaces. 


Data 

K,  m 

Cohesion,  Kpa 

Phi, 

degree 

Fmax,  N 

Obsvn  1 

0.0012 

740 

15.697 

43.789 

Obsvn  2 

0.0015 

735 

16.075 

44.901 

Obsvn  3 

0.0014 

750 

16.415 

45.905 

Why  was  this  done 


We  lack  validated  instruments  for  determining  terrain 
parameters  that  can  be  used  to  predict  small  UGV 
mobility. 

Need  a  way  to  collect  data  for  guiding  nominal 
parameter  settings  for  vehicle-terrain  interaction  in 
UGV  simulation  studies. 

There  appear  to  be  no  databases  available  that  can 
provide  insight  into  the  type  of  statistical  variability  we 
might  expect  to  see  in  the  parameters  needed  for 
models  commonly  used  in  vehicle  mobility  predictions. 
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Results  and  Conclusions 


We  showed  that  an  instrumented  robotic  vehicle  can 
be  used  to  estimate  time-varying  track  slip  and  vehicle 
slip  angle,  variables  critical  in  determining: 

a)  longitudinal  and  lateral  friction  coefficients  in  a 
baseline  skid-steer  model,  and 

b)  cohesion,  friction  angle,  and  deformation  modulus 
for  model-based  traction  force  prediction. 

These  preliminary  results  support  related  efforts 
reported  in  the  literature,  and  suggest  that  SUGVs  with 
onboard  sensors  may  provide  a  means  for  building  a 
mobility  database  for  small-scale  vehicle  platforms. 


Recommendations 


Additional  testing  is  needed  to  assess  accuracy  against 
results  from  standard  instruments,  if  available,  as  well 
as  to  generate  a  preliminary  database  useful  for 
statistical 

These  'sensor- endowed'  vehicles  are  being  developed 
and  deployed  on  diverse  terrains,  and  there  could  be  a 
way  to  use  this  data  for  the  benefit  of  prediction  and 
design. 

Support  continued  efforts  to  enable  development  of  a 
mobility  database  using  vehicle-based  'data  mining'. 
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Documentation 
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T.M.  Dar,  R.G.  Longoria,  “Slip  Estimation  for  Small-Scale  Robotic  Tracked 
Vehicles,"  2010  American  Control  Conference,  Baltimore,  MD,  J  une  30- 
J  uly  02,  2010. 

T.M.  Dar,  R.G.  Longoria,  "Estimating  Traction  Coefficients  of  Friction  for 
Small-Scale  Robotic  Tracked  Vehicles,"  2010  Dynamic  Systems  and 
Control  Conference,  Cambridge,  MA,  Sept  13-15,  2010. 

T.M.  Dar,  "Vehicle-Terrain  Parameter  Estimation  for  Small-Scale  Robotic 
Tracked  Vehicles,"  Doctoral  Dissertation,  Department  of  Mechanical 
Engineering,  The  University  of  Texas  at  Austin,  December  2010. 

I  n  progress:  journal  article  for  J .  of  Terra  mechanics  +  another  to  J .  of 
Dyn.  Sys.  Measurement  and  Control  (ASME) 


Methodology  Used 


The  approach  developed  combines  the  use  of 
Extended  Kalman  Filters  (EKF)  and  Generalized  Newton 
Raphson  (GNR)  methods  in  a  multi-tiered  algorithm. 

Implicit  in  this  approach  are  model  bases  that 
approximate  the  vehicle  dynamics  and  the  vehicle- 
terrain  interaction. 

Experiments  were  designed  accordingly: 

1.  Ad  hoc  U-turns  during  sand  pit  testing 

2.  Field  and  indoor  testing  on  various  terrains 

3.  Prepared  straight-line  tests  on  sand  and  soil  +  step 


I  ndoor  tests  employed 
the  Vicon  MoCap  to 
track  vehicle  motion, 
while  outdoor  tests 
used  a  differential  GPS 
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a  =  slip  angle 

c  =  soil  cohesion 

Fj=  tractive  force  left  track 

F^=  tractive  force  right  track 


PreMoStat 


i  =  slip  on  left/right  track 
ij=  slip  on  left  track 


*R 


slip  on  right  track 


k  =  deformation  parameter 
obsvn  =  observations 
(j)  =  soil  friction  angle 
ip  =  yaw  angle 


l|l  =  yaw  rate/turning  rate 
I  =  current  left  motor 


current  right  motor 

ou^=  angular  speed  left 
sprocket 

u^=  angular  speed  right 
sprocket 

p  =  lateral  coefficient  of 
friction 

p  =  longitudinal  coefficient  of 
1  friction 


x  =  displacement  in  x-direction 
body  fixed  coordinates 
y  =  displacement  in  y-direction 
body  fixed  coordinates 

X=  displacement  in  X- 
direction  inertial  coordinate 
Y  =  displacement  in  Y- 
direction  inertial  coordinate 


Slip  Estimation 


Having  a  good  measure  of  slip  is  critical  to 
traction  force  parameter  estimation. 

Each  track  has  slip. 


V_  v_  _vt-v 


Xl 

v. 


U  L 


Shearing  Surface  i 


F 


Track  slip  impacts  shear  displacement  along  the  track- terrain 
interface. 


Our  process:  directly  calculated  slip  using  onboard  measurements  of 
encoder  speeds  together  with  approximated  speeds  based  on  position 
measurements  made  using  either  MoCap  (indoor)  or  DGPS  (outdoor). 


This  data,  along  with  PackBot  onboard  data,  was  passed  to  algorithm. 


Model  for  Slip  Estimation 

X(k) 
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x(k)  = 


Y(k) 
¥(*) 
hQi) 
h  (k) 


From  an  ideal  kinematic  steer  model  for  a  tracked  vehicle,  introduced 
slip  in  track  and  side  slip,  so  full  (kinematic)  state  equations  become: 


—  \eoL (1  -  iL )  + 1 oR  (1  -  iR )]  (cos  y/  +  tan  a  sin  y/) 

V 

— [ coL  (1  -  iL )  +  coR  (1  -  iR  )]  (sin  y/  -  tan  a  cos  y/ ) 


x{k)  = 


2  B 


K  0  0  h )] 


o 

o 

o 


‘Assume  slip  and  side  slip  dynamics  are  zero,  lacking  dynamic  model.  So  we 
need  SNC  to  compensate  for  this  model  uncertainty. 
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Estimation  Algorithm  -  EKF 
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Observation  model: 


Zi=fc;rt;'F J 
zl=Zl-G(Xl,tl) 


H  =  dG(Xl,l.)/8X 


The  model  basis  along  with  the  EKF  construction  enables  us  to 
come  up  with  'best  estimates'  of  slip  on  each  track  and  vehicle 
slip  angle. 

Further,  we  can  embed  parameters  as  'states  to  be  estimated' 
and  all  are  computed  in  recursive  manner 


H  = 


1  0  0 
0  1  0 
0  0  1 


Kinematic  model  solved  each  step 


1)  =  t-i)  V,  )  =  / 
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Discrete  Kalman  Filter 
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Discrete  System 
Model 


X 


k  - 1 


Z  k  —  ^  k  H  kX  k 


(-) 


V 


X 


(+) 


Observation 
Mode! 


Measurement 

Mode! 


a  (-) 
Xu 


x[+)  =  x,(-}  +  K,z 


k  k 


Kalman 

Gain 


x(k)  - 
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X(kj 
Y(k ) 
V  (*) 
iL{k) 
iR(k) 

a(k) 


Slip  Estimation  -  Sand  Court 


Trajectory 


8 


-2 


0  5  10  15  20 

X  meters 

Slip  Estimate  Right  Track 


c  04 

rt 

3 03 


«>  0.2 

09 

*  0.1 

Q. 


m 


0 


-0.2  1 - * - ' - - 

0  10  20  30 

time  secs 


0.4 

g.  0.2 

"m 

0 

-0.2 


Estimated  Slip  Angle 


10  20  30 

time  secs 


Slip  Estimate  Left  Track 


time  secs 


PreMoStat 

a  =  slip  angle 
c  =  soil  cohesion 
Fj=  tractive  force  left  track 

F^=  tractive  force  right  track 

i  =  slip  on  left/right  track 
i  j=  slip  on  left  track 

i^=  slip  on  right  track 

k  =  deformation  parameter 
obsvn  =  observations 
<J)  =  soil  friction  angle 
ip  =  yaw  angle 

l|l  =  yaw  rate/turning  rate 
I  =  current  left  motor 

I  i 

1^=  current  right  motor 

ou^=  angular  speed  left 
sprocket 

u^=  angular  speed  right 
sprocket 

p  =  lateral  coefficient  of 
friction 

p  =  longitudinal  coefficient  of 
1  friction 

x  =  displacement  in  x-direction 
body  fixed  coordinates 
y  =  displacement  in  y-direction 
body  fixed  coordinates 

X=  displacement  in  X- 
direction  inertial  coordinate 
Y  =  displacement  in  Y- 
direction  inertial  coordinate 


Coefficients  of  Friction 


- ,  ^  \ 

Jr.  ■ 

v  1  J» 


I 


> 


Inertial  X-Axis 


Trajectory  X  vs  Y 


Position-body  fixed  coordinates 


Longitudinal  coefficient  of  friction 


0  10  20  30 


time  sec 

Lateral  coefficient  of  friction 


0  10  20  30 

time  sec 


Note:  Probably  should  conduct  some 
comparisons  to  existing  data  sets  to  see  how 
well  these  coefficients  predict  trajectories. 
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Algorithm  -  3 

i  Small-Scale  Tracked  Vehicle 


a  =  slip  angle 

c  =  soil  cohesion 

Fj=  tractive  force  left  track 

F^=  tractive  force  right  track 


PreMoStat 


i  =  slip  on  left/right  track 
ij=  slip  on  left  track 
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slip  on  right  track 


k  =  deformation  parameter 
obsvn  =  observations 
(j)  =  soil  friction  angle 
ip  =  yaw  angle 


l|l  =  yaw  rate/turning  rate 
I  =  current  left  motor 


current  right  motor 

ou^=  angular  speed  left 
sprocket 

u^=  angular  speed  right 
sprocket 

p  =  lateral  coefficient  of 
friction 

p  =  longitudinal  coefficient  of 
1  friction 


x  =  displacement  in  x-direction 
body  fixed  coordinates 
y  =  displacement  in  y-direction 
body  fixed  coordinates 

X=  displacement  in  X- 
direction  inertial  coordinate 
Y  =  displacement  in  Y- 
direction  inertial  coordinate 
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TABLE  23  Terrain  Values 


Moisture 

< 

** 

c 

<t> 

Terrain 

Content 

m 

n 

lb/in,*+I 

kN/m"^1  Ib/in."*1  kN/m^1 

lb/iu.1 

kPa 

deg 

Dry  sand 

(Land  Locomotion 

0 

i.i 

0.1 

0,99  3.9 

1528.43 

0.15 

1.04 

28° 

Ub.,  LLL) 

Sandy  loam 

is 

0.7 

2.3 

5.27  16.8 

1515,04 

0.25 

1.72 

29* 

(LLL) 

22 

0.2 

7 

2.56  3 

43.12 

0.2 

1.38 

38* 

Sandy  loam 

LI 

0.9 

11 

52.53  6 

1127.97 

0,7 

4.83 

20* 

Michigan  (Strong, 

23 

0.4 

15 

11.42  27 

808.96 

1.4 

9.65 

35* 

v 

FromJ.Y.  Wong,  Theory  of  Ground  Vehicles,  Wiley-I nterscience,  Jd  ed. 
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Data 

K,  m 

Cohesion,  kpa 

Phi,  degree 

Fmax,  N 

Obsvn  1 

0.01197 

1210 

28.361 

84.115 

Obsvn  2 

0.00925 

1350 

25.386 

73.944 

Obsvn  3 

0.01627 

1085 

30.913 

93.3 

Obsvn  4 

0.022 

1350 

36.91 

117.04 

Obsvn  5 

0.009 

1530 

23.03 

66.25 

Frictional  Dry  Sand 


TABLE  2.3  Terrain  Values 


Moisture 

K 

k * 

c 

Terrain 

Content 

(%) 

ft 

lb/in.B+1 

kN/mn+1 

lb/in."+2 

kN/mn+2 

lb/in.2 

kPa 

deg 

Dry  sand 

(Land  Locomotion 

Lab.,  LLL) 

0 

u 

0.1 

0.99 

3.9 

1528.43 

0.15 

1.04 

28° 

Sandy  loam 

15 

0.7 

2.3 

5.27 

16.8 

1515.04 

0.25 

1.72 

29° 

(LLL) 

22 

0.2 

7 

2.56 

3 

43.12 

0.2 

1.38 

38° 

Sandy  loam 

11 

0.9 

11 

52.53 

6 

1127.97 

0.7 

4.83 

20° 

Michigan  (Strong, 

23 

0.4 

15 

11.42 

27 

808.96 

1.4 

9.65 

35° 

Buchele) 

Sandy  loam 

26 

0.3 

5.3 

2.79 

6.8 

141.11 

2.0 

13.79 

22° 

(Hanamoto) 

32 

0.5 

0.7 

0.77 

1.2 

51.91 

0.75 

5.17 

11° 

Clayey  soil 

38 

0.5 

12 

13.19 

16 

692.15 

0.6 

4.14 

13° 

(Thailand) 

55 

0.7 

7 

16.03 

14 

1262.53 

0.3 

2.07 

10° 

Heavy  clay 

25 

0.13 

45 

12.70 

140 

1555.95 

10 

68.95 

34° 

(Waterways  Experiment 

40 

0.11 

7 

1.84 

10 

103.27 

3 

20.69 

6° 

Stn.,  WES) 

Lean  clay 

22 

0.2 

45 

16.43 

120 

1724.69 

10 

68.95 

20° 

(WES) 

32 

0.15 

5 

1.52 

10 

119.61 

2 

13.79 

11“ 

LETE  sand  (Wong) 

0.79 

32 

102 

42.2 

5301 

0.19 

1.3 

31.1° 

Upland  sandy  loam 

51 

1.10 

7.5 

74.6 

5.3 

2080 

0.48 

3.3 

33.7° 

(Wong) 

Rubicon  sandy  loam 

43 

0.66 

3.5 

6.9 

9.7 

752 

0.54 

3.7 

29.8° 

(Wong) 

North  Gower  clayey  loam 

46 

0.73 

16.3 

41.6 

24.5 

2471 

0.88 

6.1 

26.6° 

(Wong) 

Grenville  loam  (Wong) 

24 

1.01 

0.008 

0.06 

20.9 

5880 

0.45 

3.1 

29.8° 

Snow  (U.S.) 

1.6 

0.07 

4.37 

0.08 

196.72 

0.15 

1.03 

19.7° 

(Harrison) 

1.6 

0.04 

2.49 

0.10 

245.90 

0.09 

0.62 

23.2° 

Snow  (Sweden) 

1.44 

0.3 

10.55 

0.05 

66.08 

0.87 

6 

20.7° 

FromJ.Y.  Wong,  Theory  of  Ground  Vehicles,  Wi/ey-i hterscience. 


Tables  from  Gelb 


TABLE  6.1-1  SUMMARY  OF  CONTINUOUS  DISCRETE 

TABLE  4.2-1  SUMMARY  OF  DISCRETE  KALMAN  FILTER  EQUATIONS  EXTENDED  KALMAN  FILTER 


System  Model 

Measurement  Model 

xk=  (Pk-lik-l  +wk_|,  Wk~N(0>Qk> 

2k  =  HfcXk  2k  ~  N<&  Rk> 

System  Model 

Measurement  Model 

x(t)  =I(x(t),t)  +  w(t) ;  w(t)  ~  N(fl,Q(t» 

2k=llk(a(lk))+2k  :  k  =  1,2,...;  vfc  ~  N(£.  Rk) 

Initial  Conditions 

Other  Assumptions 

E(x(0)|  =  x0,  E[<x(0)  -io)(x<0)  -  x0)T|  -  P„ 
E(wkVjT]  =  0  for  all  j,  k 

Initial  Conditions 

Other  Assumptions 

x<0)  -  N(£0,  P0> 

E  [w(t)  vjcT]  -  0  for  all  k  and  all  t 

State  Estimate  Extrapolation 

Error  Covariance  Extrapolation 

£k<-)  =  ‘t>k-lik-l(+) 

Pk(")  =  *k-lPk-l(+)  *k-lT  +  Qk-l 

State  Estimate 
Propagation 

Error  Covariance 
Propagation 

x(t)  =I(£(t),t) 

P(t)  =  F(x(t),t)  P(t)  +  P(t)  FT(x(t),t)  +  Q(t) 

State  Estimate  Update 

Error  Covariance  Update 

Kalman  Gain  Matrix 

ik(+)=£k(-)  +  Rktik  “  Hk£k<->l  | 

Pk(+>=[l  -KkHklPk(-) 

Kk  =  Pk(-)  HkT|  HkPk(-)HkT  ♦  Rkf ' 

State  Estimate  Update 

Error  Covariance 
Update 

Gain  Matrix 

*k<+)  =  £k(->  +  Kktik-llk  C£k(— ))] 

Pk(+)=[I-KkHk(£k(  »]  Pk(  > 

Kk  =  Pkf-)HicT(xk(-))|Hk(xk(-»  Pkf-JHfcT&f-))  ♦  Rkj * 

Definitions 

F(x(t)0= 

9x(t)  L 

Hk(£ki-))=dYfk)) 

*  *  3i<lkl 

[t)=x(0 

2t<lk  »=Skl  — > 

I  deal  Kinematic  Steer  Models 
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For  a  kinematic  model  of  a  differentially-driven  vehicle,  we  assume  there  is  no  slip,  and 
that  the  wheels  have  controllable  speeds,  and  oo2-  The  velocity  of  the  CG  in  the  local 
reference  frame  has  a  net  effect  from  each  wheel,  composed  as, 

i1  =  Rwcox  \  Note  these  are  the  velocities  at 


2 


the  wheels. 

..  X  —  y(fi  +-^2)  “  "2  K  (^1  T  ^2 ) 

The  lateral  motion  is  constrained,  so,  y  =  0 

The  yaw  rate  is  also  composed  by  the  net  (constrained) 
motion  of  the  two  wheels,  and  you  can  show  that: 

W  =  -r(a\ -®2) 


B 


So  the  velocities  in  the  global  reference  frame  are, 


cos  y/ 

-sin^ 

0" 

X 

<1/  = 

Y 

=  ^)q  = 

sin^ 

cos^ 

0 

y 

¥ 

0 

0 

1 

¥ 

K 

2 

R 


COS^(ft>j  +co2) 

-siny/^  +a>2) 


R 


w 


B 


(&>!  -a>2) 
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rco-V 


rco 


V  =  rco\Y-i\ 


(l  iR^  +  coL(\  /z)  J 
V  . 

—  =  ys  ,  and  the  turning  rate, 
R 

¥  =^[a>R(\-iR)  +  (oL(\-iL)\ 


B  I 

\®R  Ir  ) 

i — i 

i 

H 

+ 

2I 

\jfiR  (l —  iR  j 

1 

£ 

1 

r>4. 

1 _ 1 

Kinematic  Steer  with  Slip 

— v 

tan  a  =  — 


x 

rco-V 
ma x(ra>,V) 


CD 


2B  L  R 


x 

< 
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Conclusions 


We  can  begin  understanding  how  and  when  the  level  of 
uncertainty  makes  UGV  operation  impractical. 

Closer  to  having  a  practical  means  for  quantifying  how  and  when 
a  small  UGV  is  influenced  by  terrain  variability. 

The  implementation  on  a  mobile  stand-alone  system  may  be  a 
reasonable  next-step. 

It  should  be  possible  to  incorporate  different  traction  models  into 
this  methodology. 

Prior  information  about  and/or  online  estimation  of  vehicle-terrain 
interaction  parameters  can  help  improve  UGV  traversability  on 
terrains  having  significant  variability. 
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